.DO Externa! 

.LSTON 

.Page 

>>>>>>>>>>>>>>>>>>>>>>>> 



Module: Servo 

This module contains all the specifications and source code for 
controlling the Widget Seryo Board < i.e.j. communication 
protocol, seek and head positioning, spare table lookup, etc. > 

PROCEDURE OMerLapC Response : BYTE { !rfl } 

CommandType : BVTE { }r9 > 
BiockType : BVTE < !r8 > 



B I ockHumber 

Random 

Offset 



3 BVTES { !rC:E > 
BOOLEflH { Ir7/B{t 7 } 
3 BITS { }r7/Bits 2:0 > 



) 



>>>>>;>:>>>:>>>:>>:>>>:>>>>>>> 
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> 

Function: OverLap { Overlapped Seek } 

This function allows the drive to begin a seek operation 
< if one is needed > before getting tied up w^ith the SOS 
dr i ver . 



inputs: 



Response 
CommandType 
B I ockType 
B I ockHumber 
Random 
Offset 



BVTE { !rfl } 

BVTE { !r9 > 

BVTE { !rS > 

3 BVTES i IrCiE > 

BOOLEAN { Ir7/bit 7 > 

3 BITS { fr7/bit 2:0 > 



Outputs: 



Blocks tat us 

Loca I Mar i ab I es : 
Retry 

ftlgor ! thm: 



BVTE { !rO } 
BVTE { !r4 > 



BEGIN 

IF < Srch_Cache< B I ockHumber. Random > "> 
THEN 

IF < SrchJCache.Head <> Head > 
THEN 

SelectHead< SrchJC^ache . Head ) 
Head := SrchJCache.Head 

Sector := SrchJCache. Sector 

flckJIead 
ELSE 

Retry := 4 

Temp := False 

BEPERT 



;> Retry := Retry - 1 

;> Temp := Posi tionHeadsC NoWait, Dmt_OverLap, BiockHumber ) 

• > 

•> UHTIL NOK Recovery ) OR Temp OR ( Retry = ) 

; > 

•> IF HOT< Temp > THEH Abort 

j > B I oc-kS ta t us : = Pos i t i onHeads . S ta t us 

; > TempCy I : = Pos i t i onHeads . Cy I i nder 

;> TeropHead := Posi ti onHeads. Head 

;> TeropSector := Posi ti onHeads. Sec tor 

; > ! F < ComroandType = Wr i te > 

;> THEH GetJ4rf teJData<: Response > 

;> ELSE flck_Read 

; > Load-Cache 

;> Seek< TempCy 1, TempHead, TempSector > 

;> END 

j >>>>>>>>>>>>>>>>>>>>>>>>>>>.>>> > 
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OverLap : 





Lai 1 


yrchJCache 




«Jr 


Fiz , uvrLopbeeK 




Tm 


B}kStatj*CachHdChg ; check for a head change 




Jr 


Z,Oyr_Ld_Sctr 




Xor 


Headj*01 ; complement the head value 




Push 


! rO ; save SrchJCache resu 1 t 




Ld 


!rE,Head 




Ld 


lrQ.«.HlBVTE. SslectHead 




Ld 


{rl".«.LOWBVTE. SefectHead 




Ca! ! 


BankJCa 1 1 




Ld 


!rO.*.HIBVTE. LoadJCache 




Ld 


lr1,«.L0WBVTE. LoadJ:ache 




Ca! 1 


BankJCal \ ; update the cache 




Pop 


!rO ; retrieve srch_cache result 


Ovr_Ld^clr : 


find 


?rO^*$1F ;mask off al 1 but sector info 




Ld 


Sector, !rO 




Jr 


OvrLp_End 


OvrLapSeek : 


Ld 


irO^ft.HIBVTE. CnvrtLogical 




Ld 


! r 1 , «t . LOWBVTE . Cnvr tLog i ca I 




Cal 1 


BankJCa II 




Ld 


!r4,*4 ;Retry := 4 


OvrLp-Lp : 


CIr 


! r8 ; no wa i t 




Ld 


[rO,«.HIBVTE. PosHeads 




Ld 


! r 1 , « . LOWBVTE . PosHeads 




Can 


BankJCa II 




Jr 


Hz,0vrLp_2 




Tm 


Excp t_S ta tus , *Reco ver y 



Jr 



Z,0MrLp_1 



Djnz 



!r4,0MrLp_Lp 



0MrLp_1 : 



OvrLp_2: 



Clr IrO -.byte 

Ld !r1,«StatJSrvo 

Cell I SetStatus 

Cell I Abort 

Ld lrO,«.HIBYTE. Ext_Push 

Ld lrO,«.LOWBVTE. Ext_Push 

Call BonkJCall 

Ld !rO.«.HIBVTE. LoadJCache 

Ld !r1,«.L0MBVTE. LoadJCache 

Call BankJCall ; update the cache 

Ld !rO,«.HIBVTE. LoadJLogical 

Ld «r1,*.L0WBVTE. Load_Logical 

Call BankJCall 

Call SrchJCache jmake certain block is in cache 

Jr Z,0MrLp^_1 

Call Abort 



Oi^"Lp_S_ 1 : Clr Cache- 1 ndex 

Ld !rO,*.HIBS^TE, 

Ld !r1,«.L0WBVTE. 

Ca i ! Bank_Ca 1 1 

Ld !rO,».HIBVTE. 

Ld lr1,».L0WBVTE 

Call BankJCall 



Ext_Fop 
Ext_Pop 

Seek 
Seek 



OyrLp_End : 



Ret 
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> Procedure: Seek 



This procedure accepts cylinder, head, and sector values 
and then calls position heads. 



inputs; 



Cylinder: UORD { } !rC > 
Head : BVTE { IrE } 
Sector : BVTE { IrF } 



Outputs: { none > 

Global Uaribles Changed: 

Cylinder, Head, Sector 

Algorithm; 

BEGIN 
i := 4 

UHILE < i > > AND HOT< Posi tionHeads< Wait, 

OmtJSeek, Cylinder, Head, Sector > 00 

i := ! -1 



IF < I = > 
THEN fibort 
ELSE 

G I Qba I Cy I i nder 
GiobaiHead 
Global Sec tor 



= Cy 1 i nder 
= Head 
= Sector 



Sector-Count := SectorCount + 1 
Disks tat. Parked := False 



END 



>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 
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Seek: 



Seek_Lp: 



Seek_End : 



Ld !r1,»2 

Push !r1 ;save counter 

Ld lr8,#Mait 

Ld !r1,«Dmt_Seek 

Col I PosHeads 

Pop !r1 ;get counter back 

Jr NZj,Seek_End 

Push !r1 jSQve counter 

Ld lr2,«.HIBVTE. 20 ;wait 200 ms before retrying 

Ld «r3.«.L0WBVTE. 20 

Call NsMait 

Pop !r1 ;get counter back 

j nz I r 1 , Seek_Lp 

Ld !rO,«0 ;byte 

Ld !r1,«StatJSrMO 

Co 1 1 SetStatus 

Call Abort 

Or DlskStatus,«On_Track 

Ld Cylinder, I rC 

Ld Cyl inder+1, !rD 

Ld Sector, !rF 

I new SeekCount 

ftnd DlskStat,*$FF-Parked 

Jp Bank_Ret 
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Function: PosHeads { Position Heads } 

This function is responsible for postioning the heads of 

the drive. There are two ways of positioning the heads via this 

routine: 1> Specify o logical block number < ishere all the 



USER accessable blocks are numbered from to n-1 > or 2> 
by specifying the Cylinder^ and Head number of any track 
on the disk surface. 



The uiay that Pes 1 1 i onHeads interprets the block number is 
controlled by the input parameter Logical < i.e.^ IF Logical 
THEN BlockNumber is a Logical BlockMumber ELSE BlockNumber 
is Cy I { nder and Head > . 

The Spare Table is searched ONLV if Logical is true, this is 
consistent with allowing a diagnostic program to get to any 
spot on the disk independent of the data stored there. 



Inputs: 



Wait 
Parent 
Cyl inder 
Head 
Sector 



BOOLEflH 
BVTE 
WORD { 
BVTE { 
BVTE { 



f !r8/bit 6 

{ IrB } 
!!rC } 
!rE > 
IrF } 



Outputs: 

Pos i t i onHeads : BOOLERM { Zero Flag; i.e.^ Zero is True if 

Pos i t ! onHeads is True > 



Global Uariables Changed: 

Cyl Inder, Head, Sector, CurjCyl 



Local Uariables: 

Seek, Posit ionOone : BOOLERN { !r4, !r3 > 

Cyl, Magnitude : WORD { < !rC, IrD ), < !r5, lr6 

Head, Sector, { IrE, !rF > 

PosRetry, SioRetry, { !r7, !rfi > 

Direction : BVTE { !rQ } 



Rigor i tNn: 



BEOm 

Se tOeadhanT i mer C Pos i t i onHeads , Par-en t > 
SelectHead< Head > 

Seek := CalcMagnl tudeDi recti on < Cyl, Magnitude, Direction > 

IF < Global Head <> Head > AND DiskStatus.Wr i te THEN Seek := True 

Global Head := Head 

Global Sec tor := Sector 

PosRetry := 2 

REPEAT ~ 

IF Seek AND ServoOkC Reca I cNaqflndD i r { Boolean returned in !rO } 
THEN 

IF RecalcllagflndDir THEN Seek := CalcMani tudeDi recti on < Cyl. 

Magn i tude , D i r ec t i on > 

SioRetry := 2 

WHILE ( SioRetry > > RND 

NOT < SerMorS tore < RccessUar+D i rec t i on+ 

flagnitudeC 1 1, MaqnltudeC 2 ]. 

RutoOf fset, > DO" 

I F Recovery 
THEN 

ResetSeruo 

SioRetry := SioRetry - 1 

ELSE 

SioRetry := 
IF Wait RND < SioRetry > > 
THEN WHILE NOT< SeruoReady ) DO BEGIN END 
PositionDone := NOT( ServoError ) 
PosRetry := PosRetry - t 



UHTIL HOT< Recovery > OR Posit ionDone OR < PosRetry = > 
C I earOeadManT i mer 

1 F Pos i t i onDone THEN CurJCy I : = Loca 1 Cy I i nder 
Pos ! t i onHeads := Posit ionOone 
END 



;>>>>>>>>>>>>>>>>>>>>>>>> 
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.FIN 



PosHeads : 



Clc_MagDjr: 



P_Ld_JSelHead: 
P_Ld_Retry: 

PosHds_Rpt : 



PosHds_Wh i I e : 



PosHds_4: 



Call Ext_Push ;saye callers variables 



Ld 
Cai I 

Cal I 

Cp 
Jr 
Tm 
Jr 
Ld 

Cal I 

Ld 

Ld 

Or 

Jr 

Cal I 

Jr 

Tm 

Jr 

Cal I 

Ld 

Or 

Or 

Ld 

Ld 

Ld 
Cal I 
Jr 

Tnj 
Jr 

Call 
Cal I 
Cal I 
OJnz 

Cal I 
Tia 

Jr 

Ojnz 



!rO, «Dint_PosHeads 
Set_Dfflt 



;set Dead Nan Timer 
; get re I at i ve pos i t i on 
IF GlobalHead <> Head. . 



CalchagDir 

Head, IrE 
Z,P_Ld_Betry 
DiskStat,«Wr_jOp 
Z,P_Ld_SelHead 
!r4,«1 

SelectHead 

Sector, !rF 

!r?,*2 ; Retry := 2 



!r4, !r4 ;test for Seek On 
Z,PosHds_4 ;if no seek then get out 

ServoOk ;te£t if Servo is in a reasonable state 
Z,PosHds_3 ;if not ok then retry 

DiskStatus,*On_Track ; check for recalc of magnitude and direction 

Nz,PosHds_iJh} is 

CalchagDir 

! rO, Seek_Type 

!rO, ?r9 ; Plus Direction 

!rO, Ir5 ; Plus Ns Nagnitude 

I r 1 , I r6 ; Ls Magn i tude 

Ir2,«0ff_fluto 

}r3,«S_Rate^7_6 

ServoCmnd 

Nz,PosHds_4 

Excpt_Status,«Recovery ; IF recovery 
Z,PosHdsJ5 

ResetServo 
UpDate_Hdr 
CalcNoqDir 
lrfl,PosHdsJ4hile 



Loads tatus 
! rO , *ServoErr 
Z , PosHds_3 
!r?,PosHds_Bpt 



; samp I e ServoError 

; i f servo error then retry 



Jr- 



PosHds_J3 



PosHds. 



Po£HdsJ5: 



PosHdsJ6: 



SelectHead: 



Sel-HeodO: 
Se!Hd_End: 



Tin 
Jr 
Tin 
Jr 

Cdl i 
Cal I 
Tm 
Jr 

Ld 
Ld 

Push 
Cal I 
Pop 
Tern 
Ret 

Or 
Jr 
Or 
Jr 

find 
Ld 

Jp 



;}F Wait AND HOT< ServoRdy > 

; THEM loop unti I timeout OR ServoRdy 



; sample ServoError 

; check i f pos i t i on done 



!r8.«Wai t 
Z, PosHds J5 
! rO, «SeruoRdy 
Z,PosHds_4 

ClrJ3mt 
Loads tat us 
!rO,*ServoErr 
Nz,PosHds_6 

CurJCyl , !rC 
DjrJCyl+1, IrD 



!rO ;saye status 

ExtJPop ;get caller's variables back 
!rO 

! rO . *ServoErr ; return Z = true if servo error 



!rE, IrE ; test for HeadO or Headi 
Z,Sel_HeadO 



Port3,HsO 
SelHd_End 

Ports. «$FF-HsO 
Head, !rE 

Bank_Ret 



; select head 1 
; select head 
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5- 

> Function: CalcHagDir { Calculate Magnitude and Direction ) 

> This function takes the current cylinder number < from the 

> conversion of the logical block > and generates q magnitude 

> and direction from the the position that the heads are 

> currently at < the servo needs to know a RELflTlUE distance, 

> not an absolute distance >. 



Inputs: 



LocalCyl inder : WORD { !rC, !rD } 



Outputs: 

CalchagDir : BOOLEflH { Ir4 > 
Magnitude : WORD { !r5, !r6 > 
Direction : BVTE { !r9 } 

Local Uariables : 

Temp : BOOLEAN { > 
GlobalPTR : PTR { !r2, Ir3 > 

filgorithim: 

BEGIN 

\ F Loca I Cy I i nder <> G I oba I Cy I i nder 
THEN 

f F LocQ I Cy f i nder > G I oba I Cy I i nder 



> THEN 

> Direction := Positive 

> Hagn 1 tude : = Loca I Cy I i nder - G I ofaa I Cy I i nder 

> ELSE 

> Direction := Negative 

> Magnitude := GlobalCyl inder - LocalCyl inder 

> Temp := True 

> ELSE 

> Temp := False 

> CalcMagDir := Temp 

> END 

■J. 

>>>>>>>>>>>>>>>>>>>>>>>>>>>>>;•>>> 
.LSTOFF 
.FIN 

-DO Internal 
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CalcNagDir: 

Push !rE ;save !rE 

Ld IrEj, IrD ;moMa cyl inder down one byte to use Sub': 

Ld !rD.!rC 

Clr !rC' 

Ld Irl.CurJCyl 

Ld lr2.CurJCyl+1 

Clr IrO 

Call SubS ;get Cylinder - CurrentCyl inder 

Ld ! rC , ! rD ; rep I ace cy I i nder var I ab I e 

Ld frOJrE 

Pop IrE ; rep I ace Head 

Clr !r4 ; assume no seek needed 

Jr Lt,C_f1agDir_Else 

Clr Ir5 ; assume track seek 

Clr !r5 

Ld !r9,*0 ;set direction negative 

Clr !r3 ; check for no seek condition 

Or Ir3, Ir2 ' 

Or !r3, !rt 

Or !r3, !rO 

•Jr Z,C_riagDlr_Ret 

Jr SjGlbfJCyl 

CJ1agDfr_Else: Com !r2 :2's complement sutraction result 

Com !r1 

Add !r2.«t 

fide {r1,«0 

Ld !r9,*HdJDfr_Frffld ; set direction posi tive 

SjBlblJCyl: Ld !r5, !rt ; I oad magn i tude 

Ld !r6Jr2 

Ld !r4,«01 ;set Seek 

CJ1agDir_Ret: Jp Bank_Bet 
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> 

> Function: ServoOk 

> 

> Th i s f unc 1 1 on is respons i b I e f or de term I n i ng i f the 

> servo is in a reasonable state to perform commands. In 

> other Mjords f f ServoReady and NOT< ServoError > then 

> the servo is healthy^ wealthy and wise. If^ on the other 

> hand, SeruoError is active then the state of ServoReady 

> determines the type of action to perform to try to get 

> the servo back to a nice state: 
> 

> ServoError and ServoReady: Read Status 

> ServorError and Not< ServoReady ): Data Recai 

> 

> Inputs: { none } 

> Outputs: 

> ServOk: BOOLEAN { Zero Flag, True if HOT'C ServoOk ) } 

> RecalcriagOir: BVTE { IrO } 



Local Uar i ab I es: 
Retry 
SioRetry 
Done 



BVTE { IrF > 
BVTE { !r8 > 
BOOLEflH { > 



Control I erStatusPTR : PTR { I IrC > 
fligorithm: 
BEGIN 

RecatcNagOir := False 
}F Recovery BHD ServoError 
THEN 

Retry := 4 

WHILE < Retry > > RND ServoError DO 
IF ServoReady 

THEN Servos to tus< ReadStatus, x 

X, NormalServoStatus > 

> ELSE ServoCmnd< OataRecal, x, Sc, x > 

> Retry := Retry - 1 

> IF NOT< On_Track > THEN RecalcNagDir := True 

> ServoOk := NOT< ServoError > 

> END 
> 

>>>>>>>>>>>>>>>>>>>>>>>>>>>>>>> 
.LSTOFF 
.FIN 

.00 Internal 
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. Paqe 

.FIN 



ServoOk : 



Push IrS 

Push IrC ;save register* 
Push IrD 



Ld 
Ld 



lrC,«.H!BYTE. Status-Port 
! r-D, « . LOWBVTE . Status_Port 



Tm 

Jr 

Lde 

Tm 

Jr 

Ld 



Excp t_S ta tus , «Reco very 
Z,SJOk_End 

I rO . *ServoErr 
2.SjOk_End 



IrF «2 



>>>>>>>>>>>>>>>>>>>>>>>>>> 



Or 
Jr 



IrF, IrF 
Z.SjOk_End 



; IF Recovery 
FlfiD SerMoError 



; Retry := 2 



;THErf check for retry > 



>>>>>>>>>>>>>>>>>>>>>>>>>> 



c:«_jiJK_JLp 1 . 


I 

Lde 


lrOj§}!rC j check for serMO erri 




Tin 


1 rO^ *SeryoErr 




Jp 


2,S_J0k_End 




1 In 


! ru J *oervOnQLi 




Jr 


Z,S_jOk_Else " 




Ld 


!rO.*ReadStatus ;Lo«3d servo command 1 




CIr 


!rl" 




Clr 


Ir2 




Ld 


!r3,*»S_jiorroJbtatus + b_HateJb7J& 




Cci! i 


ServoStatus ; IF NOTC Ser«/oStore'' 


t'—UK—lJeC 1 . 


Djnz 


! rr f 0-JUK_Lp I 




Jr 


S-OkJEnd 


O—Un. H ! . 


i H 

l-U 






Can 


Restore 




Jr 


SJ0k_Dec1 


SJOkJUpDate : 


Ld 


!r1,»Dmt_J3eryoOk 




Cal 1 


ReadHdr 




Jr 


2,SjOk^St_Rst 




CgI 1 


ypDGte_£ur^I:y \ 




Jr 


S_JDk_Deet 


S-JOkJSt-Rst: 


Cal I 


ResetSeruo 




Jr 


S_Ok_Dec 1 


S JOk_End : 


Lde 


! rO , @ 1 1 rC ; samp 1 e Ser uoError 




Tcffi 


!rO,*SerMoErr ; return z = true if 




Pop 


!rD ; res tore registers 




Pop 


!rC 




Pop 


!r8 




Jp 


Bank_Ret 
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